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^5 (57) Abstract: The invention concerns a device for sensing the orientation of a solid comprising: at least an angular position sensor 
fT) (lOa, 10b). capable of being made integral with the solid and of delivering at least a measurement data (Om) representing the orienta- 
tion of the solid, means (14) for generating test data (6^ representing an estimated orientation of the solid, means (18) for modifying 
the estimated orientation of the solid by comparing the measurement data and the test data. The invention is ai^licable to computer 



input peripherals, to the medical field. 
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DEVICE FOR ROTATIONAL MOTION CAPTURE OF A SOLID 



Technical field 

5 The present invention concerns a device and a process 
for sensing the orientation and the rotational motion 
of a solid. The devices for sensing motion, sometimes 
designated by mocap (motion capture) are applied in 
fields as varied as health, multimedia, mining or 
10 geophysical research: — "~ " .. .. 

In the field of application of video games or 
simulations, the motions of a user can in effect be 
registered for controlling virtual reality immersion 
15 systems. By way of example, the motions of a player can 
be registered to control the evolution of a virtual 
person in a synthesis scene. 

In the field of health, the motion capture devices can 
20 be utilised for positioning a surgical instrument or 
else for monitoring the evolution of the autonomy of 
fragile persons by taking their physical activity into 
account . 

25 In the field of portable electronics, the motion 
capture devices allow apparatus to adapt to the context 
of utilisation. They allow, for example, optimising of 
reception, of a portable telephone by recognising its 
orientation, or improving the interfaces of personal 

30 assistants. 
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Prior art 

Motion sensors, and more precisely angular position 
sensors, are greatly miniaturised and are the focus of 
5 research to impart them with a robustness and cost 
compatible with applications for the public at large. 

The position of a solid in space is entirely determined 
by the knowledge of six magnitudes. Examples of these 

10 are three magnitudes capable of translating 
translations and three other magnitudes capable of 
translating rotations. The three latter magnitudes 
correspond to angular positions. These can be utilised 
to determine motions known as skew motion, pitch motion 

15 and roll motion. 

According to the envisaged applications it is not 
always necessary to place all six associated magnitudes 
at six degrees of liberty. A more restrained number of 
20 data can in effect suffice in a large number of cases. 

Two types of sensors are mainly known which are capable 
of detecting the angular position or the rotation of a 
solid. These are on the one hand sensors sensitive to a 

25 magnetic field, such as magnetometers, and on the other 
hand sensors sensitive to acceleration, such as 
accelerometers . In an advantageous manner the 
accelerometers can measure any accelerations of the 
solid, thus for example, modifications of the 

30 orientation of the solid relative to the direction of 
the field of terrestrial gravity. 
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The magnetometers can be utilised in combination with 
an artificial source of magnetic field. All the same it 
is preferred to make use of magnetometers capable of 
5 detecting the orientation of the solid relative to the 
terrestrial magnetic field. It is considered of course 
that the directions of the magnetic field and of the 
acceleration of the apparent gravity are not colinear. 

10 The sensors can be of the type having a single axis, 
that is, sensitive according to a single direction 
unique of space. However, sensors having two or three 
non-parallel axes are preferred. These supply measuring 
values allowing an angular position of a solid to which 

15 they are solid to be recognised completely. 

The sensors supply a measuring signal. M which is 
connected to their inclination I by a function f such 
as : 

20 M = f (I) . 

The inclination is considered relative here to an 
angular reference position. The latter can be arbitrary 
or adjusted on the magnetic field or the terrestrial 
25 gravitational field. The magnitude to be known is the 
inclination I, which can be retrieved by calculation 
according to a formula I = f (M) . 

The inverse function f"^ is however difficult to 
30 establish with exactitude. In addition, it suffers from 
discontinuities and non-linearities. A difficulty is 
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attached for example to the fact that the sensors using 
the field of apparent gravity do allow rotations to be 
found at any instant about horizontal axes but not 
about the direction of apparent gravity. The same 
5 applies to magnetometers which are efficacious only for 
measuring rotations whereof the axis is not confused 
with the direction of the magnetic field used as 
reference. Non-linearities also originate from 
trigonometric functions brought up by calculating the 
10 inverse function. 

Additional inaccuracies originate from the fact that 
the sensors having three axes do not always have a very 
precise angular relation between the axes. For example, 
15 the axes are not exactly orthogonal. 

An illustration of the state of , the art; can still be 
found in the documents (1) to (4) whereof the 
references are specified at the end of the present 
20 description. 

Explanation of the invention 

The aim of the invention is to propose a device and a 
capture process of the orientation of a solid not 
25 having the abovementioned limitations and difficulties. 

An aim in particular is to propose such a device which 
is low in cost and capable of being integrated into 
equipment destined for a wide public. 

30 

Another aim is to propose a reliable device, little 
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sensitive to phenomena of non-linearity affecting 
measurements, and allowing possible imperfections in 
the sensors to be taken into account directly. 

5 To attain these aims the invention more precisely 
concerns a capture device of the orientation of a solid 
comprising : 

- at least one angular position sensor capable of being 
made solid with the solid and of providing at least one 

10 measuring datum representative of the orientation of 
the solid, 

means for generating test data representative of 
estimated orientation of the solid, 

- means for modification of the estimated orientation 
15 of the solid by confrontation of the measuring datum 

and test data . 



In the following description reference is made to the 
orientation of a solid. The solid does not however form 
20 part of the capture device . 

The orientation- corresponds more precisely to that of 
the sensor or sensors capable of being fixed to the 
solid. Furthermore, the terms orientation and angular 
25 position are utilised as synonyms. Owing to the 
inventive device it is possible to successively refine 
estimation of the orientation of the solid. 

After one or more modifications of the estimated 
30 orientation, the latter converges towards effective 
orientation of the solid, or, more precisely, towards 
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measured orientation. Therefore, the inventive device 
does not require calculation means to establish the 
orientation or the inclination of the solid on the base 
of a function (inverse) of the measuring data of the 
sensors . 

The inventive device allows the imperfections of the 
sensors to be taken directly into account and allows 
non-linear behaviours of the latter to be set free. By 
way of example, utilisation of sensors with three 
sensitive non-orthogonal axes is possible. 

According to. a particular realisation of the device, 
the modification means of the. estimated orientation can 
comprise a. _f irst comparator connected on one ..side to. 
the sensor and on- the other side to the test data 
generator means. The first comparator thus receives the 
measuring datum and a test datum, and can establish at 
least one difference between the test datum and the 
measuring datum. 

The difference between. the test datum and the measuring 
datum constitutes measuring the pertinence of the 
estimated orientation. 

The correlation between the estimated orientation and 
the test datum generated can be given, for example, by 
a direct function f as evoked in the introductory 
section of the description- This is, for example, a 
simple function of modelling of the behaviour of the 
sensors . 
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The difference between each of the successive test data 
and the measuring datum can also be put to profit to 
control the necessity or not of further refining the 
5 estimated orientation. Accordingly, the device can 
comprise a second comparator with threshold for 
comparing the difference established by the first 
comparator with a threshold value and for validating 
the estimated orientation, when . the difference 
10 established by the first comparator for a given test 
value is less than the threshold value. 

When the difference;, remains too significant, a new 
estimation of the orientation is undertaken. t : .;. 

15 _ ^ . _ . . .„ . 

The modification means- of - the estimated orientation 
and/or the generator ..means- :of - a test~:datum can comprise 
a calculator for establishing a new estimated 
orientation and/or a new test datum according to a 

20 method known as descent of error gradient. 

Furthermore, the generator means- of - test data-, can 
comprise a calculator for calculating test data as a 
function of estimated orientation, and as a function of 
25 parameters characteristic of a response of the angular 
position sensor. 

The inventive device can comprise one or more angular 
position sensors sensitive to gravity and one or more 
30 angular position sensors sensitive to a magnetic field. 
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In a more general sense other sensors are capable of 
giving information on their angular position relative 
to a reference direction of space . 

5 For example, there are sensors for measuring a 
temperature gradient, a pressure gradient, image 
sensors (visible or thermal) . 

By way of example, the sensor sensitive to gravity can 
10 comprise at least one accelerometer and the sensor 
sensitive to a magnetic field can comprise at least one 
magnetometer . 

In order to measure the angular position, in the, most 
15 complete manner and the best determined,, the device is 

preferably equipped with two-rsensors - each- having: -three. 
-~ axes J of sensitivity. r mt ir-: . . - ;sr-T™\^r-=:; 

The invention also concerns a capture device of the 
20 rotation motion of a solid comprising an orientation 
capture device such as described hereinabove and means 
.for .registering successive estimations . .. of the. 
orientation of the solid. This is, for example, a 
memory. The device can also comprise a timer for rating 
25 the registration of the successive estimations of the 
orientation of the solid. The timer also allows speeds 
and angular accelerations to be established, if 
necessary. 



30 



Calculating the motion can take place in the calculator 
and according to classic laws of kinetics of a solid. 
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The invention further relates to a process for 
estimating the orientation of a solid comprising the 
fol lowing stages : 

5 

a) input of at least one measuring datum originating 
from at least one angular position sensor and the 
establishment of at least one test datum representative 
of an estimated orientation of the sensor, 
10 b) confrontation of the test datum and of the measured* 
datum, . - 

c) establishment of at least a new test datum 
representative of a new estimated orientation of the 
solid, corrected :..as a function of :the.._ preceding 

15 confrontation,. . . _ 

d) -- repetition of stages b) et c) . t" - - --rr^': ■ 

Stages b) and c) can be repeated until the 
confrontation reveals a difference between the test 
20 datum and the measuring datum less than a determined 
threshold. 

The confrontation of the data can comprise their 
comparison or the calculation of a difference, as shown 
25 hereinabove. 

The invention differs from the devices of the prior art 
by the fact that the determination of the orientation 
is not necessarily done in constant time. In the 
30 devices of the prior art, the determination of the 
orientation is effected in a fixed time corresponding 
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to the necessary calculation time. In the case of 
iterative confrontation such as indicated hereinabove, 
the time taken by the determination of the orientation 
is, for example, associated with pertinence of the 
5 initial estimation of the orientation and the speed of 
convergence of successive estimations. In other terms, 
the time given for determining the orientation depends 
on the number of repetitions of stages b) and c) , The 
processing time does not however constitute an obstacle 

10 for implementing the process. In fact the real 
measurements made are of the order of 5 00 per sensor 
and per second. It is thus possible to effect several 
estimation, loops for .each measurement. The . number . of . 
loops is generally less than 3 0:.- Often, .a . few loops_ 

15 suffice.. _ 

.As indicated hereinabove, " : "during stage c) , a 
correlation calculation can be made according to a 
method of error gradient descent . Even though this 
20 constitutes a less preferable solution it is still 
possible to make random estimations. 

Other characteristics and advantages of the invention 
will emerge from the following description, in 
25 reference to the figure of the attached diagram. 

This description is given purely by way of illustration 
and not limiting. 



30 



Detailed description of an embodiment of the invention 
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The references 10a and 10b indicate respectively an 
accelerometer and a magnetometer. These are sensors 
with three axes of sensitivity, of known type, capable 
of providing measuring data representative of the 
5 orientation, that is, an angular position, of a solid 
S. The solid S is indicated summarily by broken lines. 
Thi s is for exampl e a part of the human body , the 
motions of which are to be studied, a computer mouse, a 
surgical instrument. 

10 

The measurements of the sensors, designated 8m/ are of 
scalar or vectorial magnitudes. - They are 
representative, for example, of angles of. skew, . roll 
and pitch (cp.,_ ©) . . . 

15 . . 

These measurements are directed i.towards "a comparator 
12. This - is, . . in the _ example"^^^J..iiiustrated, a 
differentiator. The comparator 12 also receives one or 
more test data 0t- provided by a calculator .14 . The test 

20 datum can be vectorial in type and can express angles 
according to several axes. The calculator 14 is 
utilised as means for generating test data.. The test 
data are representative of an estimated orientation of 
the solid which can be random or not. These are, for 

25 example, triplets of angles of skew, roll and pitch (cp, 
il/, 0) . The calculator can be localised on the solid S. 

The comparator provides a difference ■ A8, which, 
according to one or more axes, represents a spread 
30 between the real orientation, corresponding to the 
measuring datum, and the estimated orientation 
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corresponding to the test datum. This spread can be 
used to refine the estimated orientation of the sensor, 
and thus of the solid to which it is fixed. 

5 Nevertheless, it is possible to fix a threshold th 
beyond which it is considered that the estimated 
orientation is sufficiently close to the orientation 
measured to be validated. This can take place by means 
of a second comparator 16. . provided to compare the 
10 difference AG with the threshold value th. 

When the difference is less than the threshold in 
absolute value the test, datum .8t, that is, . the 
estimation of the angular position, is directed: towards 
15 an output O. 

- — . However, when . the difference .is- -greater- «it*iani_:-the- 
threshold, it is directed towards the calculator 14 to 
effect a new estimation of .the. position. The 

20 comparators 12 and 16 thus constitute with the 
calculator 14 means 18 for modification of the 
estimated orientation of the solid • : 

The new estimation can be random. It can also be 
25 refined according to a correction calculation by the 
error gradient descent method. This method, known per 
se, is illustrated by the document (4) whereof the 
coordinates are specified at the end of the description 
and to which reference can be made to complete the 
30 explanation. 
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The second comparator can optionally be eliminated. In 
this case, the estimated value is continually refined 
until the input of a new measurement value. 

5 The device of the figure comprises means, for example a 
memory, for registering the successive estimated 
values, validated, as a function of successive 
measurements of .the angular position of the solid. The 
memory M can be part of the calculator and can be 

10 localised on the solid S. The successive values enable 
calculation of the motion of rotation of the solid as 
well as its speeds and angular accelerations. To start 
the measuring ,of .a new orientation of the. solid,, the 
first test, datum generated is advantageously .the. 

15 validated estimated value of the preceding position. 

. "The - capture of v^.measurement- values by - ther^sensors-,— -and. 
the registering of the estimated values in the memory 
M, can be rated by a timer. H. 

20 

Contrary to the process of the known type of direct 
inversion, the, .capture process of the orientation . of a 
solid according to the invention allows utilisation of 
any number of sensors, provided that this number is 

25 greater than the number of variables of angle I to be 
estimated (the number of variables of angle I to be 
estimated is between 1 and 3) . According to the desired 
quality of* the estimation, a device according to the 
invention can . thus comprise the minimal number of 

30 sensors necessary or a number of sensors greater than 
the minimal number (redundancy) . 
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According to a refinement of the invention, the 
contribution of each sensor can be weighted. A 
criterion of confidence or weight Cm is then 
5 established which is associated with each - constituent 
of the measurement 0m in order' to take the latter more 
or less into account in the algorithm of angles 
research. The calculation of a weight Cm is established 
according to the following rules: 
10 - a) the weight Cm hais a value equal to 1 by default, 

- b) the weight' Cm takes the value 0 in the event where 
the provided measurement ' * is an aberrant value 
(saturation, value translating bad functioning, etc. -) , 

- c) the weight Cm has a value equal -to -0 when t-he 
-15 level of noise measured- by- t-he- sensor exceeds a certain 

threshold, an * intermediate value varying linearly from 
0 to~*r'able to^ b^-"" applied' values varying "from 
the threshold value to a noise value considered as 
negligible, 

20 - d) the confidence is reduced on the accelerometers if 
the total acceleration measured moves away in standard 
- from the value* of apparent gravity, 

- e) the confidence is reduced on the magnetometers if 
the magnetometers register an excessive variation in 

25 their standard (the presence of a ferromagnetic 
object (s) in the vicinity of the sensor can then be 
suspected) . 

In the absence of weighting, for iteration done by the 
30 calculator 14, the modification of a test angle I is 
associated with the magnitude Si such as : 
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^/=Zl(^/«^®")' ^^^^^ 

n is the index of a sensor, 
N is the number of sensors, 

am is a parameter relative to the index sensor n, 
calculated usually by the gradient descent, 
A0n is the spread between the real orientation and the 
estimated orientation of the index sensor n. 

The introduction of a weight Cmn relative to the index 
sensor n then modifies the expression of the magnitude 
Si as foliows: 



. S,=Xl,CmnXa,„Aen) 

In general, the values of a weight Cmn can evolve 
continuously between the value 1 (total confidence in 
the measurement made by the index sensor n) and the 
value 0 (total -absence of confidence in the measurement 
made by the index sensor .n,, .-the .mea.sur.ement -made by the 
index sensor n is not taken into consideration) . 
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Claims 

!• Capture device of the orientation of a solid 
comprising: 

at least -a sensor-(10a, 10b) of angular position, 
capable of being made solid with the solid and of 
supplying at least a measuring datum (©m) 
representative of the orientation of the solid, 
means (14) for generating test data (©t) 
representative of an estimated orientation of the 
solid, 

means (18) for modification of- the estimated 
orientation of the solid by conf rontation of - the 
measuring datum and test data. - 



2. Device as claimed in Claim 1, wherein the 
mbdific^tibn means (18-) of the' ''estimated orie^itatibn 
comprise a first comparator (12) connected to the 
sensor (10a, 10b) and to the means (14) for generating 
test data, for receiving the measuring datum and at 
least a test datum, and for establishing at least a 
difference '(AG) between the test datum and the- 
measuring datum. 

3. Device as claimed in Claim 2, further comprising a 
second comparator with threshold (16) for comparing the 
difference established by the first comparator (12) to 
a threshold value (th) and to validate the estimated 
orientation, when the difference established by the 
first comparator is less than the threshold value. 
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4. Device as claimed in Claim 1, comprising at least an 
angular position sensor (10b) sensitive to the gravity 
and at least an angular position sensor (10a) sensitive 
to a magnetic field. 

5. Device as claimed in Claim 4, wherein the sensor 
sensitive to gravity comprises at least an 
accelerometer and the sensor sensitive to a magnetic 
field comprises at least a magnetometer. 

10 

6. Device as claimed, in Claim 4, comprising two sensors 
each having three axes of sensitivity. 

7. Device as claimed in Claim 1, wherein the means (14) 
15 for generating test data comprise a , calculator for 

calculating test data -as a ^function of an estimated 
orientation,- _-and as a . function- of parameters* 
characteristic of a response of the angular position 
sensor , 

20 

8. Device as claimed in Claim 7, wherein the calculator 
is localised on the solid. - 

9. Device as claimed in Claim 1, wherein the 
25 modification means (18) of the estimated orientation 

and/or the means for generating a test datum comprise a 
calculator for establishing a new estimated orientation 
and/or a new test datum according to a method known as 
error gradient descent . 



30 
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10. Device as claimed in Claim 9, wherein the 
calculator is localised on the solid. 

11. A motion capture device of the rotation of a solid 
5 comprising a capture device of the orientation, -as 

claimed in any one of the preceding claims and means 
(M) for registering successive estimations of the 
orientation of the solid. 

10 12. Device as claimed in Claim 11, wherein the means 
(M) for registering are localised on the solid. 

13. Device as claimed in Claim 11, comprising a timer 
(H) for rating the registration of the. successive 
15 estimations -Of -the orientation .of . the . solid;. _ ._ 

14 . r A :,-process - f or- • estimation -jtof i- .the orientation -of a 
solid comprising the following stages: 

a) capture of measuring data originating from at 
20 least one angular position sensor (10a, 10b) and 

the establishment of a test datum representative 
of an. estimated orientation-/of the . solid, 

b) confrontation of the test datum and the measured 
datum, 

25 c) establishment of a new test datum representative 

of a new estimated orientation of the solid, 
corrected as a function of the preceding 
confrontation, 
d) repetition of stages. b) and c) . 

30 



15. Process as claimed in Claim 14, wherein the stages 
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b) and c) are repeated until the confrontation reveals 
a difference between the test datum and the measuring 
datum less than a determined threshold. 

16. Process as claimed in Claim 14, wherein, during 
stage c) , correction calculation is made according to a 
method known as error gradient descent . 

17. Process as claimed in Claim 14, wherein 
confrontation .test data ' and the measuring datum 
comprises the establishment of difference data (AG) 
between successive test data and the measuring datum. 

18. Process of motion>_.capture of a solid,, characterised 
in that the process as—claimed. in Claim-.1.4„_ is repeated- 
with successive measuring data. 
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Abstract 

The present invention relates to a capture device of 
the orientation of a solid comprising: 
5 - at least a sensor (10a, lOb) of angular position, 
capable of being made solid with the solid and of 
supplying at least a measuring datum 
(0m) representative of the orientation of the 
solid, . - 
10 - means (14) for generating test data (0t) 
representative of an estimated orientation of the 
■ solid, ^- 
- means (18) for modification of the estimated 
orientation of the solid by corif rohtation of the 
15 - measuring datum- and test data. - - — - - - 

-'"Application to comiputer input ^ peripherals, in the 
medical field. 



20 Sole figure. 



